package com.xiaoyao.myframeapp.utils.Navisdk;

//TODO 坐标转换 1 基础地球坐标  2 谷歌、高德是一次加密的火星坐标  2 百度是火星坐标再次加密的

import com.baidu.mapapi.model.LatLng;

import java.util.HashMap;
import java.util.Map;

/**
 * 标准地球坐标即GPS设备获得的坐标，该坐标需要经过国家测绘局进行加密后形成火星坐标（WGS-84 ），我们用的google坐标和高德地图坐标也就是火星坐标
 * 百度地图，在火星坐标的基础上再进行一次加密，形成了百度地图上的坐标，因此，直接将标准地球坐标显示在百度地图上是会有几百米的偏差的。
 * 按照此原理，标准GPS坐标经过两步的转换可得到百度坐标。因为在处理百度地图时，例如查询其POI都需要百度地图上的坐标，而不是标准坐标，那么这样的转换就是必要的了
 */
public class AddressUtil {
    static double x_pi = 3.14159265358979324 * 3000.0 / 180.0;

    /**
     * 百度坐标转火星坐标
     *
     * @param bd_lat
     * @param bd_lon
     * @return
     */
    public static LatLng bdToMars(double bd_lat, double bd_lon) {
        double x = bd_lon - 0.0065, y = bd_lat - 0.006;
        double z = Math.sqrt(x * x + y * y) - 0.00002 * Math.sin(y * x_pi);
        double theta = Math.atan2(y, x) - 0.000003 * Math.cos(x * x_pi);
        return new LatLng(z * Math.sin(theta), z * Math.cos(theta));
    }

    public static LatLng bdToEarth(double bd_lat, double bd_lon) {
        LatLng marsLatLng = bdToMars(bd_lat, bd_lon);
//		return marsLatLng;
        return mars2Earth(marsLatLng.longitude, marsLatLng.latitude);
    }

    /**
     * 火星坐标转百度坐标
     *
     * @param gg_lat
     * @param gg_lon
     */
    public static LatLng marsToBd(double gg_lat, double gg_lon) {
        double x = gg_lon, y = gg_lat;
        double z = Math.sqrt(x * x + y * y) + 0.00002 * Math.sin(y * x_pi);
        double theta = Math.atan2(y, x) + 0.000003 * Math.cos(x * x_pi);
        return new LatLng(z * Math.sin(theta) + 0.006, z * Math.cos(theta)
                + 0.0065);
    }

    private static double pi = 3.14159265358979324D;// 圆周率
    private static double a = 6378245.0D;// WGS 长轴半径
    private static double ee = 0.00669342162296594323D;// WGS 偏心率的平方

    /**
     * 中国坐标内
     *
     * @param lat
     * @param lon
     * @return
     */
    public boolean outofChina(double lat, double lon) {
        if (lon < 72.004 || lon > 137.8347)
            return true;
        if (lat < 0.8293 || lat > 55.8271)
            return true;
        return false;
    }

    public static double transformLat(double x, double y) {
        double ret = -100.0 + 2.0 * x + 3.0 * y + 0.2 * y * y + 0.1 * x * y
                + 0.2 * Math.sqrt(Math.abs(x));
        ret += (20.0 * Math.sin(6.0 * x * pi) + 20.0 * Math.sin(2.0 * x * pi)) * 2.0 / 3.0;
        ret += (20.0 * Math.sin(y * pi) + 40.0 * Math.sin(y / 3.0 * pi)) * 2.0 / 3.0;
        ret += (160.0 * Math.sin(y / 12.0 * pi) + 320 * Math.sin(y * pi / 30.0)) * 2.0 / 3.0;
        return ret;
    }

    // 84->gcj02
    public static double transformLon(double x, double y) {
        double ret = 300.0 + x + 2.0 * y + 0.1 * x * x + 0.1 * x * y + 0.1
                * Math.sqrt(Math.abs(x));
        ret += (20.0 * Math.sin(6.0 * x * pi) + 20.0 * Math.sin(2.0 * x * pi)) * 2.0 / 3.0;
        ret += (20.0 * Math.sin(x * pi) + 40.0 * Math.sin(x / 3.0 * pi)) * 2.0 / 3.0;
        ret += (150.0 * Math.sin(x / 12.0 * pi) + 300.0 * Math.sin(x / 30.0
                * pi)) * 2.0 / 3.0;
        return ret;
    }


    /**
     * 地球转火星
     *
     * @param lon
     * @param lat
     * @return
     */
    public static Map<String, Double> transform(double lon, double lat) {
        HashMap<String, Double> localHashMap = new HashMap<String, Double>();
//		if (outofChina(lat, lon)) {
//			localHashMap.put("lon", Double.valueOf(lon));
//			localHashMap.put("lat", Double.valueOf(lat));
//			return localHashMap;
//		}
        double dLat = transformLat(lon - 105.0, lat - 35.0);
        double dLon = transformLon(lon - 105.0, lat - 35.0);
        double radLat = lat / 180.0 * pi;
        double magic = Math.sin(radLat);
        magic = 1 - ee * magic * magic;
        double sqrtMagic = Math.sqrt(magic);
        dLat = (dLat * 180.0) / ((a * (1 - ee)) / (magic * sqrtMagic) * pi);
        dLon = (dLon * 180.0) / (a / sqrtMagic * Math.cos(radLat) * pi);
        double mgLat = lat + dLat;
        double mgLon = lon + dLon;
        localHashMap.put("lon", mgLon);
        localHashMap.put("lat", mgLat);
        return localHashMap;
    }
    // gcj02-84

    /**
     * 火星转地球
     *
     * @param lon
     * @param lat
     * @return
     */
    public static LatLng mars2Earth(double lon, double lat) {
//		Map<String, Double> localHashMap = new HashMap<String, Double>();
        double lontitude = lon
                - (((Double) transform(lon, lat).get("lon")).doubleValue() - lon);
        double latitude = (lat - (((Double) (transform(lon, lat))
                .get("lat")).doubleValue() - lat));
//		localHashMap.put("lon", lontitude);
//		localHashMap.put("lat", latitude);
//		return localHashMap;
        return new LatLng(latitude, lontitude);
    }
}
